* NOTICES * 

JPO and NCIPI are not responsible for any 
damages caused by the use of this translation. 

1. This document has been translated by computer. So the translation may not 
reflect the original precisely. 

2. **** shows the word which can not be translated. 
3.ln the drawings, any words are not translated. 

CLAIMS 
(57) [Claim(s)] 

[Claim 1] a. A partition means to classify the space where a mobile robot moves 
into radii and at least two linear field fields to which an attribute changes with 
either at least, And it consists of a sensor component of n (n> 1) individual 
arranged succeeding the shape of an array which outputs a different signal 
according to a difference of the b. aforementioned attribute. While setting it as 
the value the same as that of the width of face of said sensor array to which is 
equipped with the sensor array arranged near said mobile robot's touch-down 
part, and the width of face of said partition means is specified by said n sensor 
components, or almost same Location detection equipment of the mobile robot 
characterized by detecting the relative position of said mobile robot and said 
partition means based on a difference of the output signal of m (m<n) individual 



with which it continues of the n sensor components which constitute said sensor 
array, and the output signal of the remaining n-m individuals. 
[Claim 2] a. A partition means to classify the space where a mobile robot moves 
into radii and at least two linear field fields to which an attribute changes with 
either at least, And it consists of two or more sensor components arranged 
succeeding the shape of an array which outputs a different signal according to a 
difference of the b. aforementioned attribute. While setting it as the value the 
same as that of the width of face of said sensor array to which is equipped with 
the sensor array of two trains arranged to the ends near said mobile robot's 
touch-down part, and the width of face of said partition means is specified by 
said two or more sensor components, or almost same The output signal group of 
two or more sensor components which constitute the sensor array arranged by 
one side of said two trains, Location detection equipment of the mobile robot 
characterized by the thing of whenever [ relative-position / of said mobile robot 
and said partition means /, and angular relation ] for which either is detected at 
least based on the difference of the output-signal group of two or more sensor 
components which constitute the sensor array arranged on another side. 
[Claim 3] a. A partition means to classify the space where a mobile robot moves 
into at least two field fields to which an attribute changes with radii, And it 
consists of two or more sensor components arranged succeeding the shape of 



an array which outputs a different signal according to a difference of the b. 
aforementioned attribute. While setting it as the value the same as that of the 
width of face of said sensor array to which is equipped with the sensor array of 
two trains arranged to the ends near said mobile robot's touch-down part, and 
the width of face of said partition means is specified by said two or more sensor 
components, or almost same The output signal group of two or more sensor 
components which constitute the sensor array arranged by one side of said two 
trains, Location detection equipment of the mobile robot characterized by the 
thing of whenever [ relative-position / with the central point of the radii which 
constitute said mobile robot and said partition means based on the difference of 
the output-signal group of two or more sensor components which constitute the 
sensor array arranged on another side /, and angular relation ] for which either is 
detected at least. 

[Claim 4] Location detection equipment of the mobile robot given in claim 3 term 
characterized by for said mobile robot being a working robot and locating the 
central point of said radii on the vertical line for an activity. 
[Claim 5] Location detection equipment of a mobile robot given in either of claim 
1 term to the 4th term characterized by arranging said sensor array in parallel 
with a robot's travelling direction. 

[Claim 6] a. A leg formula mobile robot's location in migration space, and a 



detection means of an include angle to detect either at least, And it asks for the 
deflection of a location, and the include angle and target position by which the b. 
aforementioned detection was carried out. A correction means of the desired 
value concerning a gait or a gait according to it to correct either at least, It 
consists of two or more noncontact type sensor components which are the 
control units of the leg formula mobile robot which has **, and have been 
arranged as said detection means succeeding the shape of an array. While 
having the sensor array of at least 2 trains arranged to the ends of said mobile 
robot's foot The output signal group of two or more sensor components which 
constitute the sensor array arranged by one side of said two trains, The control 
unit of the leg formula mobile robot characterized by the thing of said mobile 
robot's location, and an include angle for which either is detected at least based 
on the difference of the output-signal group of two or more sensor components 
which constitute the sensor array arranged on another side. 
[Claim 7] a. A leg formula mobile robot's location in migration space, and a 
detection means of an include angle to detect either at least, And it asks for the 
deflection of a location, and the include angle and target position by which the b. 
aforementioned detection was carried out. A correction means of the desired 
value concerning a gait or a gait so that said deflection may not accumulate to 
correct either at least, It consists of two or more noncontact type sensor 



components which are the control units of the leg formula mobile robot which 
has **, and have been arranged as said detection means succeeding the shape 
of an array. While having the sensor array of at least 2 trains arranged to the 
ends of said mobile robot's foot The output signal group of two or more sensor 
components which constitute the sensor array arranged by one side of said two 
trains, The control unit of the leg formula mobile robot characterized by the thing 
of said mobile robot's location, and an include angle for which either is detected 
at least based on the difference of the output-signal group of two or more sensor 
components which constitute the sensor array arranged on another side. 
[Claim 8] The control unit of claim 6 term characterized by being what outputs 
the signal from which said sensor component differs according to a difference of 
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said attribute while forming a partition means to classify it into at least two field 
fields to which attributes differ in said migration space, or a leg formula mobile 
robot given in 7 terms. 

[Claim 9] The control unit of a leg formula mobile robot given in either of claim 6 
term to the 8th term characterized by setting the width of face of said partition 
means as the value the same as that of the width of face of said sensor array to 
which it is specified by said two or more sensor components, or almost same. 
[Claim 10] The control unit of a leg formula mobile robot given in either of claim 6 
term to the 9th term characterized by the thing of the foot order ends to which the 



right-and-left ends and the travelling direction of the foot which is parallel to said 
robot's travelling direction, and the sensor array of said at least 2 trains cross at 
right angles arranged at least at either. 

[Claim 1 1] The control unit of a leg formula mobile robot given in either of claim 6 
term to the 10th term to which said noncontact type sensor component is 
characterized by being an optical sensor component. 

[Claim 12] The control unit of a leg formula mobile robot given in either of claim 8 
term to the 11th term which the space where said leg formula mobile robot 
moves is a stairway, and is characterized by establishing the attribute which 
represents said edge in near the left right end section of a stairway side for said 
partition means. 

[Claim 13] 1st means to determine or correct the desired value about the walk 
course of said robot's arbitration in a. spiral staircase in a leg formula mobile 
robot's control device, It has 2nd means to detect whenever [ relative-position / 
of the b. aforementioned robot and a spiral staircase /, and angular relation ]. 
And said 2nd means While having the sensor array of at least 2 trains which 
consisted of two or more noncontact type sensor components arranged 
succeeding the shape of an array, and were arranged to the ends of said mobile 
robot's foot The output signal group of two or more sensor components which 
constitute the sensor array arranged by one side of said two trains, Either is 



detected at least, the difference of the output-signal group of two or more sensor 
components which constitute the sensor array arranged on another side — being 
based -- whenever [ relative-position / of said mobile robot and said spiral 
staircase /, and angular relation ] - Said 1st means is the control unit of the leg 
formula mobile robot characterized by being what is based on whenever [ said 
relative-position / which said 2nd means detected corresponding to said desired 
value to the n-th time of arbitration /, and angular relation ], and determines or 
corrects said n+1st following desired value. 

[Claim 14] The control unit of a leg formula mobile robot given in either of claim 8 
term to the 12th term characterized by carrying out actuation control of said leg 
formula mobile robot's leg in near said partition means at least so that the step 
may serve as the die length of 2 double less or equal substantially [ the travelling 
direction die length of said partition means ]. 



DETAILED DESCRIPTION 

[Detailed Description of the Invention] 
[0001] 

[Industrial Application] This invention relates to the thing which enabled it to 



more specifically detect simply the relative location thru/or the bearing in 
workspace of a mobile about a mobile robot's location detection and control unit. 
Moreover, it is related with what is controlled to be able to move to landing 
locations, such as a stairway, also in the environment where constraint is 
received, about a leg formula mobile robot at stability and a high speed among 
mobile robots. 
[0002] 

[Description of the Prior Art] Although the thing of various gestalten, such as a 
wheel type, a crawler type, and a leg formula, is proposed as a mobile robot until 
now, when such a mobile robot is workspace and performs a certain task, the 
object for an activity being on workspace and working toward the object is called 
for. However, since uncertain elements, such as slipping between the 
measurement errors, migration devices, and road surfaces of a self-location, 
intervene during migration, after a mobile robot moves, he is not certain in 
whether the object for an activity is faced correctly. For such a reason, a mobile 
robot needs to recognize correctly which direction after migration termination, 
self is in which location to the object for an activity, and has turned to. 
[0003] Of course, although it will be satisfactory if it can continue measuring the 
self physical relationship for [ which is approaching during migration ] an activity 
in the real time, such technique needs huge information processing and, at least 



at present, is not realistic. Laying an artificial auxiliary means (for example, tape) 
in accordance with moving trucking to migration space in order to decrease the 
amount of information processing is proposed by JP,59-32009,A, 
JP,59-121506,A, JP,55-97609,A, etc. Moreover, it is also well-known to lay an 
electromagnetic wire etc. underground. 

[0004] However, when based on these technique, while preparing a facility 
required for a workspace side and being complicated, great cost is needed for 
laying an electromagnetic wire etc. underground. Furthermore, when workspace 
is nuclear installation, modification of a large-scale environment cannot be 
performed as a matter of fact in many cases. 

[0005] Moreover, in order to recognize self location and bearing to the object for 
an activity, carrying out between the images beforehand remembered to be the 
picturized images using the pattern-matching technique etc. using vision 
information, such as a camera, is also known. By this technique, in order to 
usually reduce the amount of information which should be processed, windowing 
of some images is carried out and the search time is shortened, since it usually 

comes out to look for an inspection object further after the device of others 

j 

equipped with the description usually still clearer than a pressure gage etc. 
which uses for self-location identification the image which picturized the device 
which is an object for inspection, for example, a pressure gage etc., or a building 



construction are used for self-location identification and being able to identify a 
selMocation and there is although working hours can shorten better if it becomes 
when a mobile robot's activity is inspection of a device, whenever 
[ working-speed ] is late Although whenever [ working speed ] can be raised by 
increasing the engine performance of the computer to carry, it is desirable to use 
the computer of the low engine performance in respect of cost, and when it is the 
robot of an autonomous mold, the engine performance of a computer is naturally 
restrained from weight, consumption energy, etc. 
[0006] 

[Problem(s) to be Solved by the Invention] It is in this invention proposing the 
location detection equipment of the mobile robot which it was made in view of 
such a situation, is only giving few land markers to workspace, and can detect 
comparatively whether the working robot accompanied by migration arrived at 
the activity location correctly with a sufficient precision in the real time using the 
computer of the low engine performance. 

[0007] Furthermore, in a mobile robot, when what has a discrete landing location 
moves the environment where constraint is received to a landing location like a 
leg formula mobile robot (for example, when going up and down a stairway etc.), 
it is necessary to control a landing location careful. That is, if a crawler bearing 
area utilizable in order that the relative position of a robot and a stairway may 



maintain back past ** and stability becomes small, a position becomes unstable 
and a relative position passes a front conversely in case a leg formula mobile 
robot goes up a stairway, as shown in drawing 33 , when moving to the next 
stage, **** will interfere and the stability of a position will be broken down 
similarly. Thus, when landing locations, such as a stairway, move the 
environment where constraint is received, it is necessary to control the relative 
position of a robot and a stairway. 

[0008] Then, the applicant for this patent has proposed the control unit of the leg 
formula mobile robot which enabled it to move previously the environment where 
a leg formula mobile robot receives constraint in migration, such as a stairway, to 
a high speed with the stable position in Japanese Patent Application No. No. 
241,351 [ four to ]. However, since the sole was equipped with the contact type 
sensor as a location detection means in the proposal, endurance was not 
necessarily enough. 

[0009] The 2nd object of this invention is in amelioration of that invention 
proposed previously. Therefore, more specifically While it is comparatively 
detectable using the computer of the low engine performance whether the 
working robot accompanied by migration only at attaching few land markers in 
workspace reached correctly in the activity location with a sufficient precision in 
the real time It is in offering the control unit of the leg formula mobile robot raises 



endurance using a noncontact type sensor and it was made to raise self-location 

identification precision further. 

[0010] 

[Means for Solving the Problem] In order to solve the above-mentioned technical 
problem, this invention was constituted as shown for example, in claim 1 term. If 
it is in claim 1 term when the expression of the example mentioned later is 
written in addition and explained A partition means to classify the space where a 
mobile robot 1 ,100 moves into radii and at least two linear field fields to which an 
attribute changes with either at least (land marker 80), And it consists of a 
sensor component of n (n> 1) individual arranged succeeding the shape of an 
array which outputs a different signal according to a difference of said attribute. It 
has the sensor array 382 arranged near said mobile robot's 1,100 touch-down 
part. While setting the width of face of said partition means (land marker 80) as 
the value the same as that of the width of face of said sensor array 382 to which 
it is specified by said n sensor components, or almost same The output signal of 
m (m<n) individual with which it continues of the n sensor components which 
constitute said sensor array 382 (for example, ON signal), It constituted so that 
the relative position of said mobile robot 1,100 and said partition means (land 
marker 80) might be detected based on a difference of the output signal (for 
example, off signal) of the remaining n-m individuals. [0011] 



[Function] The relative position thru/or include angle to a partition means can be 
detected easily, and, therefore, a mobile robot's (working robot) location in 
migration space can be detected easily. Moreover, since it is simple as a 
configuration, it is comparatively realizable with the computer of a low. 
[0012] 

[Example] Hereafter, taking the case of the leg formula mobile robot of a 
2-pair-of-shoes walk, and a wheel-type mobile robot, the example of this 
invention is explained as a mobile robot. 

[0013] Drawing 1 is explanation skeleton drawing, showing a leg formula mobile 
robot's robot 1 on the whole, and equips the leg link 2 of each right and left with 
six joints (the electric motor which drives it shows each joint for the facilities of an 
understanding). To the order from a top, the joints of these six individuals are the 
joints 10R and 10L (right-hand side is set to R and left-hand side is set to L.) for 
leg winding of the waist. Below The same joints 12R and 12L of the pitch 
direction (it rotates to the circumference of a x axis) of the waist, The joints 14R 
and 14L of this roll direction (it rotates to the circumference of the y-axis), the 
joints 16R and 16L of the roll direction of a knee region, While being the joints 
18R and 18L of the roll direction of a guide-peg neck, and the joints 20R and 20L 
of this pitch direction and attaching **** (foot) 22R and 22L in the lower part, a 
case (base) 24 is formed in the most significant, and a control unit 26 is stored in 



the interior. 

[0014] In the above, a waist joint consists of joint 10R (L), 12R (L), and 14R (L), 
and an ankle joint consists of joint 18R (L) and 20R (L). Moreover, it is the thigh 
links 32R and 32L between a waist joint and a knee joint, and is connected by 
the leg links 34R and 34L between a knee joint and an ankle joint. Here, the leg 
link 2 can give six degrees of freedom about a guide peg on either side, 
respectively, and it can give the movement toward a request to the whole guide 
peg, and it consists of driving these 6x2=12 piece joints (shaft) at a respectively 
proper include angle during a walk so that three-dimension space can be walked 
to arbitration. Although it has the reducer which the above-mentioned joint which 
stated previously consists of an electric motor like, and doubles the power that 
output further, since that detail is given to the application (Japanese Patent 
Application No. No. (JP,3-184782,A) 324218 [ one to ]) which these people 
proposed previously and it is not just going to consider in itself as the summary 
of this invention, the explanation beyond this is omitted. 

[0015] In the robot 1 which shows drawing 1 , well-known 6 axial-tension sensor 
36 is formed in a guide-peg neck, the force components Fx, Fy, and Fz of x, y, 
and the direction of z transmitted to a robot through **** and the moment 
components Mx, My, and Mz of the circumference of the direction are measured, 
and the existence of landing of a foot, the magnitude of the force of joining a 



support saddle, and a direction are detected. Moreover, it replaces with the 
distribution load sensor of the contact process used for the rear face of ****22R 
(L) with the technique proposed previously as a location detection means, and is 
equipped with the reflective type photosensor 38 of a non-contact mold (it is a 
graphic display abbreviation at drawing 1 ). 

[0016] Furthermore, the dip sensor 40 is installed in a case 24, and the 
inclination to the z-axis within a x-z flat surface, the angular velocity and an 
inclination [ similarly as opposed to the z-axis within a y-z flat surface ], and its 
angular velocity are detected to it. Moreover, the rotary encoder which detects 
the rotation is prepared in the electric motor of each joint. Furthermore, although 
omitted in drawing 1 , the zero switch 42 for amending the output of the dip 
sensor 40 is formed in a robot's 1 proper location. These outputs are sent to the 
control unit 26 in the above mentioned case 24. 

[0017] Drawing 2 is the block diagram showing the detail of a control unit 26, and 
consists of microcomputers. In there, the output of the dip sensor 40 etc. is 
changed into digital value with A/D converter 50, and the output is sent to 
RAM 54 through a bus 52. Moreover, while the output of the encoder which 
adjoins each electric motor and _is arranged is inputted in RAM54 through a 
counter 56, the output of a zero switch etc. is similarly stored in RAM 54 through 
a waveform shaping circuit 58. In the control unit, the 1st and 2nd arithmetic unit 



60 and 62 which consists of a CPU is formed, and like the after-mentioned, the 
1st arithmetic unit 60 computes a target joint include angle by reading the gait 
parameter stored in ROM64, and sends it out to RAM54. Moreover, like the 
after-mentioned, the 2nd arithmetic unit 62 reads the desired value and the 
detected actual measurement from RAM 54, and outputs it to the electric motor 
which computes a control value required for actuation of each joint, and drives 
each joint through D/A converter 66 and a servo amplifier. Moreover, the 
environmental map information about workspace is stored in ROM64. 
[0018] Here, if the photosensor 38 previously described with reference to 
drawing 3 and drawing 4 is explained, while constituting a photosensor 38 from a 
detecting element 382 and a body 384 of a sensor, five detecting elements 382 
are arranged in the shape of [ each ] an array in one train at the both sides of 
****22R (L), respectively, and the amount of reflected lights of the light emitted 
by the floor line from the light-emitting part is detected. And a detecting element 
382 is connected with the body 384 of a sensor with a fiber optic cable 386, and 
a lightwave signal (reflected light) is made to transmit through it. The body 384 of 

- • ■ 

a sensor changes a lightwave signal into an electrical signal (digital). 
Management of wiring is difficult for even the control unit 26 which contained 
many fiber optic cables and the cables for electrical signals to the case 24 via 
many [ for moving part ] leg link 2 wiring, since the photosensor 38 is used by ten 



one leg, and wiring weight also increases. Then, we decided to equip the 
location only near a detecting element as much as possible with the body 384 of 
a photosensor, and the interior of leg link 34R (L) was more specifically 
equipped. 

[0019] Furthermore, inside [ on either side ] leg link 34R (L), one D/A converter 
39 is arranged near the body group of a sensor, respectively, the sensor output 
of a total of ten pieces is changed into every five-piece one analog signal, it 
sends out to A/D converter 50 in a control unit 26 through a multi-conductor 
cable 72, and an analog signal is changed into the digital signal in which 
numerical processing is possible there. The 1st arithmetic unit 60 reads required 
data from A/D converter 50 through a bus 52, performs suitable processing, 
doubles the outside of ****22R (L), each five insides, and the leg on either side, 
and detects the output state (ON/OFF) of a total of 20 photosensors 380. This 
output state sets the time of the reflected light being in a photosensor to ON. 
[0020] Here, spacing of the center to center of the sensor detecting element 382 
of each five trains is set to 5mm. In addition, width of face of ****22R (L) is set to 
200mm as shown in drawing 5 . Since considering the range detectable by five 
sensor arrays of one side a relative position does not understand all sensors in 
the state of ON or OFF, in detecting edges, such as a stairway, as shown in 
drawing 5 for example, as shown in this drawing, ON or since it is undetectable 



in it being off, all outputs serve as the range of 15mm corresponding to 1-4 
pieces in the number of ON. If the detection range sets to 15mm, 
relative-position errors, such as landing control, must be made into less than [ it ], 
but as a practical question, by 15mm, since the detection range is too small, it 
expands the detection range using a land marker. That is, since the width of face 
of a sensor array will be substantially set to about 20mm if the land markers 80 
width of face is set into a value almost equal to the width of face of a sensor 
array and detecting-element spacing is set to 5mm like the above-mentioned as 
shown in drawing 6 , the land marker's 80 width of face is also set to 20mm 
equivalent to it (it exaggerates for the facilities of an understanding and a 
drawing shows). In the case of amplification and an example, by this, the width 
of face of the detection range can be expanded **20mm (40mm) and more than 
twice most effectively. 

[0021] If this land marker 80 is explained further, the land marker 80 consists of 
field fields of the predetermined width of face which consists of a straight line 
which drew light, such as black paint, on the location suitably in workspace 82 in 
the coatings of the floor line of the front for [ 84 ] inspection (it is the flange of 
piping in the case of an example) absorbed well, as shown in drawing 7 . Thus, 
the land marker 80 is formed and the floor line of workspace 82 is classified into 
two field fields to which attributes differ in lightness. When it is on the land 



marker 80, and while carrying out bed leaving of the photosensor output, it 
becomes off. 

[0022] Here, as a robot 1 shows drawing 3 (and drawing 1 ), the inspection 
system 90 is formed in the upper part of a case 24. The inspection system 90 
consists of a table 92 (universal head) which can rotate freely horizontally (x-y 
flat surface), and a camera 96 attached in the vertical direction (x-z flat surface) 
free [ rotation ] at the post 94 which protrudes from the top face. A table 92 and a 
camera 96 are driven through a proper means (not shown). That is, a robot 1 
walks to the neighborhood for inspection, he moves a table 92 and a camera 96 
so that the object for inspection can be picturized, and he checks the existence 
of abnormalities through image recognition processing. In addition, that 
explanation is omitted while omitting a graphic display by drawing 2 about 
actuation control of a table etc. and inspection by the image processing, since 
the object of this invention is in detection or walk control of a location. 
[0023] In the above-mentioned configuration, a robot 1 can walk toward the 
object 84 for inspection, and the relative current position to the land marker 80 in 
this workspace can be identified because ****22R (L) lands on the land marker 
80. Furthermore, since the photosensor 38 is formed in ****22R (L) on either 
side the couple every, the include angle of ****22R (L) to the land marker 80, i.e., 
the include angle of the leg link 2, can be detected by measuring the sensor 



output which is a pair, and the relative bearing to the land marker 80 can be 
detected. Based on the vision information which follows and is acquired through 
environmental map information and a camera 96, the object for inspection is 
approached certainly, the camera 96 on a table 92 is driven, and inspection can 
be performed. 

[0024] Here, a relative-position gap [ before and after ] (deflection) is taken as 
the average of a gap of the outside of ****22R (L) and the inside. As shown in 
drawing 8 , an include-angle gap of ****22R (L) does the division of the 
difference of the gap detected by the sensor detecting element of the outside of 
****, and the inside sensor detecting element by the width of face of ****, and 
computes it in quest of an arc tangent. Although the sensor has been arranged 
in two trains in this example in order to obtain an include-angle gap, this has 
been arranged to the ends of ****, spacing was enlarged as much as possible, 
. and the resolution of include-angle gap detection was raised. 
[0025] Since this example was detected as mentioned above, the relative 
location and the bearing to the land marker in workspace can be recognized 
easily, and environmental map information can be used, and the object for 
inspection can be reached easily. And it has been the thing of a low enough 
comparatively as a microcomputer which is simple as a configuration and 
constitutes a control unit 26. 



[0026] Drawing 9 shows the 2nd example of this invention, and shows the case 
where two or more land markers 80 are formed. In this case, the relative bearing 
and the relative location to the object 84 for inspection are detectable based on 
environmental map information from either of the land markers 80 who detected. 
[0027] If a biped is arranged and it does not land, but a few is shifted and it lands 
when landing in the land marker 80 neighborhood, since both **** are equipped 
with the sensor array in the example although the include angle of ****22R (L) to 
the land marker 80 is detectable also by one **** in the 1st and 2nd 
above-mentioned example, the probability to land on the land marker 80 will 
become high. 

[0028] That is, in the 1st and 2nd example of the above, when a robot arrives at 
the land marker 80 neighborhood, actuation control of the leg shall be carried out 
so that quiescence or the step in front of that may serve as twice thru/or a value 
not more than it substantially [ the land marker's 80 travelling direction die 
length ]. Consequently, it enables it to certainly locate a photosensor array on 
the land marker 80, to be mistaken, and to detect that there is nothing. 
[0029] Therefore, it can move from a distant place to the last inspection location 
by dead REKONINGU by inner sensors (step [ of a gait parameter ] x information 
searched for by the number of steps), and the application distance of dead 
REKONINGU can be expanded. Since the frequency using external sensors, 



such as a camera 96, is decreased, buildup of the processing time resulting from 
the complexity of information processing common to an external sensor can be 
prevented, passing speed increases further, and it becomes more practical to 
extend the distance of dead REKONINGU. 

[0030] Drawing 10 is the explanatory view showing the 3rd example of this 
invention, in the case of this 3rd example, approached in the floor line at the both 
sides of a car body using the wheel-type mobile robot 100, and equipped with 
the detecting element 382 of a photosensor 38 in the shape of an array ( drawing 
10 shows only one side). Moreover, as shown in this drawing and drawing 1 1 , in 
the case of the 3rd example, the land marker 80 is expressed in the field field 
which consists of radii centering on the point C of being located on the vertical 
line for [ 84 ] inspection. Although there was inconvenience which cannot detect 
where [ of the land marker 80 ] a robot is located, but must scan the camera 96 
of an inspection system along with a certain imaginary line on space since the 
land marker 80 was a straight line in the case of the 1st and 2nd above 
mentioned example Since the land markers 80 are radii in the case of the 3rd 
example, as shown in drawing 1 1 , a robot's absolute location and bearing to the 
core C of radii (object for inspection) can be correctly recognized at once by 
extending a perpendicular from the middle point of a line to which the sensor 
array of both sides is connected. In addition, two or more land markers 80 may 



be formed also in the 3rd example. 

[0031] In any [ of the 1st to 3rd example ] case, since a self location can be 
promptly identified after arriving at the neighborhood for inspection, the 
inspection system 90 can be turned to the direction for [ which was calculated ] 
inspection at accuracy, it is not necessary to change a robot's location and 
sense into searching for the object 84 for inspection by trial and error, and a 
self-contained robot's maximum important concerns slack energy expenditure 
can be reduced remarkably. 

[0032] In addition, in the 1st to 3rd example, although it explains on the 
assumption that a robot lands on a land marker, it may not be located by the 
precision mistake of dead REKONINGU. However, what is necessary is just to 
check the gap to self location and land marker using a camera 96, if such cases 
should be rare and it should be generated. Even in such a case, since a land 
marker functions as the focus, he is easy and the burden of a computer also has 
them than the conventional technique which extracts a certain description from 
the structure in an environment, and identifies a self-location. [ few ] 
[0033] Drawing 12 is a flow chart which shows the 4th example of this invention, 
and is a flow chart which shows actuation of the migration control device 
concerning this invention. The 4th example is related with walk control in case 
the leg formula mobile robot which showed in the 1st example goes up and down 



a stairway. As shown in drawing 13 , the land marker 80 is laid by this side and 
each stage of a stairway. 

[0034] In addition, the 4th example is amelioration of the application (Japanese 
Patent Application No. No. 241,351 [ four to ]) which these people proposed 
previously. By the distributed load sensor of a contact process which one of the 
improving points is a location detection means, and was used previously, since 
there was inconvenience to which endurance gets worse in order that the big 
load at the time of a walk and a landing impact might act on the sole, it is in 
having used the photosensor 38. It was described previously. Two of improving 
points are improvement in precision of the location detection at the time of 
stairway rise and fall. Although explained, since it is hereafter stated to the 
application proposed previously for details, explanation is stopped simply. 
[0035] If this control is put in another way as a premise when several steps of 
rise and fall are possible even if it does not control the relative position of a robot 
and a stairway, the range which can be walked to the relative position of a robot 
and a stairway will exist, and the case where the relative-position gap generated 
in the rise and fall which are one step is small will be considered. It enabled it to 
go up and down a stairway continuously by not performing control for landing 
**** on a target position in this control at accuracy, since it thinks [ that it is 
actually such in many cases and ], but performing control which prevents that 



this relative-position gap accumulates, and controlling within limits with the walk 
possible in which which described the relative position of a robot and a stairway 
above, although it approves that a relative-position gap occurs in one step of 
arbitration. 

[0036] Drawing 14 is control-block drawing showing the detail of this control. A 
target landing location (desired value) and U (z) S (z) by a diagram A step 
command value (control input), A real landing location (controlled variable) and 
E (z) Y (z) A relative-position gap (system deviation), In an integral element and 
(1/z), 1 sampling lag unit and K (z) express a control device, and, as for delta (z), 
G (z) expresses [ disturbance and I (z) ] the pulse transfer function from a robot's 
(controlled system) step command value to a real step. These relation comes to 
be shown in several 1 and several 2. 
[0037] 
[Equation 1] 



G (z) U+z- 1 I (z) K (z) } 

Y (z) = S (z) 

1 +Z- 1 I (z) K (z) G (z) 



I 

+ A (z) 

1+z" 1 I (z) K (z) G (z) 



[0038] 



[Equation 2] 



G (z) fz- 1 +K Cz) } 
z - 1 +K ( z) G (z) 



S Cz) 



z - 1 

+ A (z) 

z - 1 +K (z) G (z) 



z il-G (z) 

E Cz) = S Cz) 

z- 1 +K Cz) G Cz) 



z-l+K (z) G Cz) 



A Cz) 



[0039] Temporarily, for simplification, Gain k, then conditions for stability show G 

(z) to Gain g, and come to show control unit K (z) to several 3. 

[0040] 



[Equation 3] 

I Z I < 1 



l-kg< 1 -» -kg<0 -> kg>0 
- 1 < 1 -kg -* -2<-kg ~> k g < 2 



0 < k g < 2 



[0041] Moreover, if the die length of a stairway is fixed at L (shown in drawing 
15 ), since a target position will change in the shape of a step, the steady-state 
deviation over this comes to be shown in several 4, and is converged on 
constant value according to k, g, and L. 
[0042] 



[Equation 4] 



e oo = 1 i m ( 1 - Z 



Z (1 -g) 



z -> 1 z - 1 z-l+kg 



z Cl-g) 

= 1 l m 



z -*> 1 z - 1 + k s 
1 -g 

L 

kg 



[0043] Similarly, the steady-state deviation over the disturbance of the shape of 
an impulse of magnitude D and step-like disturbance comes to be shown in 
several 5 and several 6, and is converged on constant value according to 0, or k, 



g and D 



[0044] 



[Equation 5] 



e 00 = 1 i m (1— z ') • z~ e • D • 

z-* 1 z-l+kg 

<z - 1 ) • z" e 
= 1 i m d 

1 z-i+kg 



0 

- D 



k g 



= 0 



[0045] 



[Equation 6] 



e oo = 1 im (1-z" 1 ) 



Dz 
z - 1 



z — 1 + k g 



= 1 i m 
z-» 1 



z-l+kg 



D 



1 

k g 



D 



[0046] What is necessary is just to determine Gain k so that it may be promptly 



completed by the relative-position gap generated according to disturbance etc. 
and steady-state deviation may be settled in tolerance. Furthermore, if control 
unit K (z) is constituted so that an integral element may be included, steady-state 
deviation over step-like desired value and step-like disturbance can be set to 0. 
[0047] Here, G (z) was first identified as gain g. Drawing 16 expresses x(n)/u (n) 
with a histogram. Although he wanted to identify G which does not include the 
effect of disturbance (z), i.e., g, originally, since detection of w (n) was difficult, it 
identified from x(n)/u (n). Since it is presumed that what is depended on 
disturbance is large as for the factor of the skirt being large, it does not become a 
big problem as gain about G (z). Since the core of distribution was 1 .02, it was 
thought that it was good also as g= 1.02, but it was referred to as g= 1.06 in 
order to evaluate to an insurance side. Control unit K (z) is made into Gain k. 
Conditions for the control system at this time to become stability are set to 0< 
k<1.89 (**2/g) from several 3 formulas. From several 4 formulas etc., k set to k- 
0.5 or 0.75, in order that steady-state deviation might avoid that the property of a 
control system becomes in oscillation although it becomes small and the larger 
one might give allowances to gain. 

[0048] Moreover, the result at the time of not performing this control for a 
comparison is shown in drawing 17 . Drawing 18 and drawing 19 are the results 
at the time of performing this control, and, in the case of k= 0.5, drawing 19 of 



drawing 18 is the case of k= 0.75 inside. The die length of the stairway which 
each went up and down is 280mm. When not performing this control so that 
clearly from drawing 17 , a relative-position gap will increase almost linearly and 
it will exceed 20mm in the 3 to 4th step. On the other hand, as for it, the result of 
having performed this control turns out [ which were shown in drawing 18 and 
drawing 19 ] like that a relative-position gap is not emitted but is converged on 
about 1 constant value. It is converged as about 10mm by the case of k= 0.5, 
and the case of k= 0.75 is converging the relative-position gap on about 7.5mm. 
Since it is set to 7mm as g= 1 .02 at the time of 1 1mm and k= 0.75 at the time of 
k= 0.5 according to several 4 formulas, it turns out that the result of this control 
sees theoretically and is appropriate. 

[0049] With reference to the drawing 12 flow chart, actuation of this control unit is 
explained on the assumption that the above. 

[0050] First, each part of equipment is initialized by S10, and it progresses to 
S12, and loads from ROM64 which described the gait parameter above there. 
Here, a robot's gait shall be beforehand designed in consideration of dynamic 
stability conditions, and shall be memorized by ROM64 as a gait parameter. This 
gait parameter is expressed in a **** target landing location etc. Then, if it 
progresses to S14, a start signal is stood by and a start signal arises, it 
progresses to S16, and a counter will be incremented, and it will progress to S18, 



and will judge whether it is gait correction timing. About this, it mentions later. 
[0051] When denied by S18, a position parameter is calculated by subsequently 
to S20 progressing. Since this has some which need a interpolation operation in 
the above mentioned gait parameter, it calculates the position parameter of the 
time of day which asks for it here and is specified with the counter of S16. Then, 
unless progress to S22, and calculate the include angle of 12 joints and it 
progresses to S24, and stand by a synchronizing signal, outputs the joint include 
angle computed by having progressed to S26 in the place which was able to 
take the synchronization, it progresses to S28 and it is judged as walk 
termination, while returning to S16 and repeating the same activity, when judged 
as termination, it progresses to S30, and a counter is reset and it finishes. That 
is, the loop formation of S16 to S28 is carried out to every [ of the counter of 
S16 ] unit time amount (for example, 20ms). Moreover, although servo control is 
performed-like in parallel according to the flow chart shown in drawing 20 in the 
2nd arithmetic unit 62 described above so that it might become that joint include 
angle based on the joint include angle outputted by S26, since this activity is 
well-known, explanation is omitted. 

[0052] In the procedure so far, a robot reproduces and walks a stable gait on the 
dynamics target designed beforehand. Moreover, control for maintaining the 
stability of a walk against disturbance is also performed simultaneously. 



However, the explanation about stabilization control is omitted here. It can go up 
and down a stairway until a relative-position gap is accumulated and it separates 
/ from a robot by the described conventional technique by the above from the 
range which can walk a relative position. In this control, when die length went up 
and down the general stairway which is 280mm, the above mentioned range 
which can walk a relative-position gap was influenced by **60mm, and an 
environment and disturbance, but on the average, since the relative-position gap 
generated in per rise and fall of one step of stairway was about 5 to 10mm, it has 
gone up and down succeeding ten-step order. 

[0053] Here, although it was judged in the drawing 12 flow chart whether it is gait 
correction timing in S18, the event of a foot carrying out bed leaving in this 
control was made into gait correction timing. Since having considered timing 
which detects a relative-position gap as the time of bed leaving can correct a **** 
orbit using between [ whole ] swing phases if a relative-position gap is detected 
before bed leaving and it feeds back to a target landing location, while 
modification that it is not rapid and smooth is attained and being able to 
suppress lowering of the stability of a gait to the minimum, it is because the 
newest relative-position gap can be used for control in time. 
[0054] And when judged as the time of bed leaving by S18, it progresses to S32, 
when the robot has gone up and down the stairway, the photosensor 38 



arranged at ****22R (L) detects the edge of a stairway for every step, and the 
relative-position gap with a stairway is detected as compared with the target 
position of the edge indicated in the gait parameter. Then, the target landing 
location which it does not accumulate according to a gap of the relative position 
and include angle which progressed to S34 and were detected and which 
determines the suitable amount of target step corrections like, progresses to S36 
continuously, and is indicated in the gait parameter is rewritten. 
[0055] Updating of a target landing location specifically changes a step from the 
gait with which a robot's gait was designed beforehand. For example, by +20mm, 
if the relative-position gap by the stage of arbitration sets to 0.5, Gain k will set 
the step of one step as follows to 280mm(die length of stairway)-(20mmx0.5) 
=270mm so that clearly from drawing 15 . And since the landing location of 
****22R (L) is determined by the revolution of the circumference of x, y, the 
directions of z, and those shafts, those all or parts are corrected so that it may 
become the changed step. If the above procedure is repeated for every step 
during stairway rise and fall, accumulation of a relative-position gap can be 
prevented and any number of steps can go up and down continuously. 
[0056] Since this example was constituted as mentioned above, also in the 
environment where constraint is received, it can move to landing locations, such 
as a stairway, at stability and a high speed. Furthermore, since a relative 



position is detectable also in a flat location without the edge before a stairway as 
shown in drawing 13 , while a corrective action becomes possible from one step 
of the beginning, a relative position is detectable even if a bias is in the 
distribution of load of a robot's sole, as shown in drawing 21 . Moreover, since a 
photosensor 38 is a non-contact type, its endurance also improves. 
[0057] Drawing 22 is the explanatory view showing the 5th example of this 
invention. In this case, while having arranged the detecting element 382 of a 
photosensor 38 in the shape of an array at the ****22R (L) order edge, the land 
marker 80 was installed so that it might become a robot travelling direction and 
parallel. Thereby, the location and include angle of a longitudinal direction are 
detectable by the same principle. Furthermore, if a sensor detecting element is 
arranged right and left before and after **** so that naturally, the location of a 
robot's cross direction, the location of a longitudinal direction, and all the angle of 
rotation are detectable. In addition, other configurations and effectiveness do not 
differ from the content shown previously. 

[0058] Drawing 23 is the explanatory view showing the 6th example of this 
invention. In the case of this example, notching section 80a was formed in the 
ends of the land marker 80 located near the right-and-left edge of a stairway. 
Consequently, since three field fields where attributes differ in lightness are 
constituted continuously and a sensor output is different by notching section 80a 



as shown in drawing 24 , **** 22R was located there, namely, can detect having 
landed near the right-and-left*edge of a stairway, and can change a track near 
the mid gear of a safe stairway. 

[0059] Drawing 25 is the explanatory view showing the 7th example of this 
invention, and shows the control when going up and down a spiral staircase. As 
a spiral staircase shows drawing 26 , when it has the same curvature to Core Cs, 
the walk course should increase as the distance over Core Cs becomes large. 
This example was made paying attention to that point. 

[0060] Hereafter, if it explains along with the drawing 25 flow chart, it starts from 
S10 and progresses to S18, and it will be judged as gait correction timing, will 
progress to S32, and a gap will be detected. It is the same as that of the 4th 
example so far. 

[0061] It continues in the 7th example, progresses to S320, and is the target step 
Lo (shown in drawing 26 .). Gap deltaL of said step Wn, and a being the same 
and a actual step is compared with the predetermined value LTH. The 
predetermined value LTH of the probability from which it separated from the 
planned walk course of a spiral staircase when exceeding this is high, and it is 
the decision criterion which needs course correction. It is the distance planned 
through a plan course (broken line) in drawing 26 . By S320, it shifts, and when it 
is judged that deltaL does not exceed the predetermined value LTH, it 



progresses to S322 and S324, and the amount of corrections is determined if 
needed, a gait parameter is corrected, and a step is amended. 
[0062] When it progresses and shifts to S326 when it is judged that it shifted in 
S320 and deltaL exceeded the predetermined value LTH, and whether it 
checked that deltaL was the same sign, the value of a counter was incremented, 
it progressed to S328, and the counter value became two or more judges and it 
is denied, it progresses to S322. On the other hand, since it can presume that 
the course has swerved from the thing of a plan actually when it is judged that 
the counter value became two or more by S328, for example, as shown in 
drawing 26 , a gait parameter is corrected in S330 and a course is amended. 
Then, it progresses to S332, and a counter value is reset, it progresses to less 
than [ S20 ], and the same processing as the 4th example is performed. In 
addition, in this example, it cannot be overemphasized like the 4th example that 
a land marker is laid in this side and each stage of a spiral staircase. 
[0063] Since it constituted like the above, also when going up and down a spiral 
staircase, according to an expected locus, the 7th example is stabilized and can 
always be walked. 

[0064] Drawing 27 is the explanatory view showing the 8th example of this 
invention, replaces with P control law shown in the drawing 14 block diagram on 
the occasion of the decision of the amount of corrections of S34 of the drawing 



12 flow chart, and shows the example which corrects desired value using a 
PID-control rule. A residual configuration does not differ from the content thru/or 
the 4th and 7th example shown previously. 

[0065] Drawing 28 is the explanatory view showing the 9th example of this 
invention, and shows the example which combined the adaptive control rule with 
the PID-control rule. 

[0066] Drawing 29 is the explanatory view showing the 10th example of this 
invention, and senses bending of slipping of a road surface and ****, secular 
change, and a link etc. by that learning function using a neural network. 
Moreover, the neutral zone which can absorb the die length of a stairway is then 
formed. In addition, the strength of association between the neurone shown by O 
mark in drawing 29 is updated by BP rule. 

[0067] In the above-mentioned 1st thru/or the 10th above-mentioned example, 
since detection of a relative position will be attained if a flat road surface also 
installs a land marker, it is applicable also to the location which needs to detect a 
self-location to accuracy besides a stairway, for example, as shown in drawing 
30 , when exceeding ranging over an obstruction (the location of a cross 
direction becomes important in this case), as it is shown in drawing 31 , when 
passing through a narrow path (the location of a longitudinal direction becomes 
important), it is a time (the location of order and a longitudinal direction, and 



angle of rotation — it both becomes important) of turning, as shown in drawing 32 
etc. Furthermore, if the parameter to control is discrete when arriving thru/or 
passing at the time of day set to the target point thru/or the passage point when 
walking a sleeper or rail top, ** which is an include angle as it is a location cannot 
be asked, but it can apply widely. 

[0068] Drawing 30 can be applied also when a track should be changed in the 
middle of moving trucking, it only draws the land marker on the location of the 
turn, and is movable to stability and a high speed. If desired moving trucking is 
guided by this technique, it can recognize to accuracy to the bearing which 
spreading of paint decreases remarkably compared with the case where a guide 
wire is applied covering the whole path, and could not be known with that 
conventional technique. 

[0069] In the above 1st thru/or the 10th example, although two kinds, a leg 
formula and a wheel type, were mentioned as a mobile robot's example, the 
following differences are among both according to a migration mechanism. In 
the thing of a wheel type, since the sensor itself moves a road surface 
continuously, if it is taking notice of only the output of the sensor of the beginning 
of a sensor array even if the precision of dead REKONINGU is somewhat bad, it 
can presume having arrived at the request point with the event of an output 
signal changing. It is higher for practicability to use this invention for a 



wheel-type mobile robot in this semantics. 

[0070] On the other hand, there is not necessarily a possibility of a landing 
location being theoretically discrete and straddling a land marker in a leg formula 
mobile robot, however, the thing for which a land marker's width of face is made 
large — or like the above-mentioned, when it approaches near the, it can 
respond by improvement of a gait, such as narrowing a step. Moreover, as for 
the orbit of ****, apart from it, it is desirable also in a fundamental gait to set 
[ which becomes close to a road surface as much as possible ] up like. In 
addition, since a leg formula mobile robot is in dominance overwhelmingly in a 
stairway walk as shown in the 4th and 7th example, when the stairway is 
included in moving trucking, it is useful [ this invention ] to use it for a leg formula 
mobile robot. 

[0071] In addition, in the above 1st thru/or the 10th example, although a leg 
formula and wheel-type mobile robot's example was shown, it cannot be 
overemphasized that it carries out appropriate also to the robot of a crawler type. 
<BR> [0072] 

[Effect of the Invention] If it is in claim 1 term, the relative position thru/or include 
angle to a partition means can be detected easily, and, therefore, the relative 
position of the mobile robot (working robot) and object in migration space can be 
detected easily. Moreover, since it is simple as a configuration, it is 



comparatively realizable with the computer of a low. 

[0073] If it is in claim 2 term, the relative position thru/or include angle to a 
partition means can be easily detected like claim 1 term, and, therefore, 
whenever [ of duality location / of the mobile robot (working robot) and object in 
migration space / and angular relation ] can be detected easily. Moreover, it is 
comparatively realizable with the computer of a low. 

[0074] If it is in claim 3 term, the absolute location thru/or absolute include angle 
to a partition means can be detected easily, and, therefore, a location can be 
more easily detected for whenever [ of duality location / of the mobile robot 
(working robot) and object in migration space /, and angular relation ]. Moreover, 
it is comparatively realizable with the computer of a low. 

[0075] If it is in claim 4 term, the relative bearing to the object for an activity is 
easily detectable. 

[0076] If it is in claim 5 term, the location of the travelling direction to the object 
for an activity and bearing are easily detectable. 

[0077] If it is in claim 6 term, while the location and include angle in migration 
space are detectable, it can detect with the rear face at the head of the leg also 
about the field where a distributed load is small, and detection precision can be 
raised. Furthermore, the endurance of equipment can be raised. 
[0078] Like claim 6 term, if it is in claim 7 term, while the location and include 



angle in migration space are detectable, it can detect with the rear face of **** 
also about the field where a distributed load is small, and detection precision can 
be raised. Furthermore, the endurance of equipment can be raised. 
[0079] If it is in claim 8 term, a location and an include angle can be detected and 
a corrective action becomes possible from one step of the beginning at the time 
of stairway rise and fall also in a flat location without the edge of this side which 
goes up and down a stairway. Moreover, also in case the location which needs 
to detect a location or an include angle exact besides rise and fall of a stairway is 
walked, it can apply. 

[0080] If it is in claim 9 term, the detection range can be expanded most 
effectively. 

[0081] If it is in claim 10 term, the resolution of a detection include angle can be 

raised and detection precision can be raised. 

[0082] Endurance can be raised if it is in claim 1 1 term. 

[0083] If it is in claim 12 term, it can go up and down a stairway safely. 

[0084] If it is in claim 13 term, also when going up and down a spiral staircase, 

according to an expected locus, it can always stabilize and walk. 

[0085] If it is in claim 14 term, a land marker's location is certainly detectable. 



DESCRIPTION OF DRAWINGS 



[Brief Description of the Drawings] 

[Drawing 1] It is the schematic diagram, showing a mobile robot's location 
detection and control device on the whole taking the case of the leg formula 
mobile robot of a 2-pair-of-shoes walk. 

[Drawing 2] It is the explanation block diagram of the control unit shown in 
drawing 1 . 

[Drawing 3] It is the explanation side elevation showing the leg formula mobile 
robot of drawing 1 focusing on arrangement of a location detection means 
(photosensor). 

[Drawing 4] It is the explanatory view showing the installation condition of the 
photosensor to **** of the leg formula mobile robot of drawing 3 . 
[Drawing 5] It is the explanatory view showing the detection range of the 
photosensor when not preparing a land marker in an environment side with the 
configuration of drawing 3 . 

[Drawing 6] It is the explanatory view showing the detection range of the 
photosensor at the time of preparing a land marker with the configuration of 
drawing 3 . 

[Drawing 7] It is the explanatory view showing the 1st example of this invention 



showing the neighborhood for inspection in workspace, and a land marker. 
[Drawing 8] It is the explanatory view showing the example which detects a gap 
(bearing) with the configuration of drawing 3 . 

[Drawing 9] It is the explanatory view showing the 2nd example of this invention 
showing the neighborhood for inspection in workspace, and a land marker. 
[Drawing 10] While using radii as a land marker in the 3rd example of this 
invention, using a wheel type as a mobile robot, it is the explanatory view 
showing the case where that core is set on the vertical line for inspection. 
[Drawing 11] It is the explanatory view showing detection of the core (object for 
inspection) of the radii in the 3rd example. 

[Drawing 12] It is the flow chart which shows the 4th example of this invention. 
[Drawing 13] It is the explanatory view showing the migration space (stairway) in 
the 4th example, and a land marker. 

[Drawing 14] It is the block diagram showing the landing location amendment 
control of the control of the drawing 12 flow chart. 

[Drawing 15] It is the explanatory view showing rise-and-fall actuation of the 
stairway planned by drawing 14 . 

[Drawing 16] It is the histogram which shows the gap property of a actual landing 
location over the target landing location at the time of a robot's stairway rise and 
fall. 



[Drawing 17] It is experimental data drawing showing the gap with the target 
landing location when going up and down a stairway, without a robot with the 
property shown in drawing 16 performing this control, and a actual landing 
location. 

[Drawing 18] It is experimental data drawing showing the gap with the target 
landing location when a robot with the property shown in drawing 16 performing 
this control, and going up and down a stairway, and a actual landing location. 
[Drawing 19] It is another experimental data drawing showing the gap with the 
target landing location when a robot with the property shown in drawing 16 
performing this control, and going up and down a stairway, and a actual landing 
location. 

[Drawing 20] It is the flow chart which shows the activity for which it opts by the 
drawing 12 flow chart, and which carries out servo control of the joint include 
angle outputted to desired value. 

[Drawing 21] It is the explanatory view showing the condition that it is detectable 
in the field where a distributed load is small, with the configuration of drawing 3 . 
[Drawing 22] It is the explanatory view showing the 5th example of this invention 
showing the example which prepares so that it may become parallel to a robot 
travelling direction on a stairway, and enabled it to detect the location and 
include angle of a longitudinal direction. 



[Drawing 23] It is the explanatory view showing the 6th example of this invention. 
[Drawing 24] It is the explanatory view showing detection actuation in the 6th 
example. 

[Drawing 25] It is the flow chart which shows the 7th example of this invention. 
[Drawing 26] It is the explanatory view showing detection actuation in the 7th 
example. 

[Drawing 27] It is control-block drawing showing the 8th example of this invention. 
[Drawing 28] It is control-block drawing showing the 9th example of this invention. 
[Drawing 29] It is control-block drawing showing the 10th example of this 
invention. 

[Drawing 30] It is the explanatory view in which a leg formula mobile robot shows 
the condition over an obstruction. 

[Drawing 31] It is the explanatory view showing the condition that a leg formula 
mobile robot passes through a narrow path. 

[Drawing 32] It is the explanatory view in which a leg formula mobile robot shows 
the condition of turning. 

[Drawing 33] It is the explanatory view showing the condition that a leg formula 
mobile robot goes up a stairway. 
[Description of Notations] 

1 Leg Formula Mobile Robot (2-Pair-of-Shoes Bipedal Robot) 



2 Leg Link 

10R, 10L Joint for leg winding 

12R, 12L Joint of the pitch direction of the lumbar part 

14R, 14L Joint of the roll direction of the lumbar part 

16R, 16L Joint of the roll direction of a knee region 

18R, 18L Joint of the roll direction of a guide-peg neck 

20R, 20L Joint of the pitch direction of a guide-peg neck 

22R, 22L **** (foot) 

24 Case (Base) 

26 Control Unit 

38 Photosensor 

80 Land Marker 

82 Workspace 

84 Object for Inspection 

90 Inspection System 
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i 

(57) mmm®.®] 

mm-<D®ic®ft*z>ymc Mip-b y?7 v^m 

fS.*2>n®(D-kyifm*<Dn %(T>W^ &m (m<n) 
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[11*312] a. %9}U$y hmW)t%£?4*. R3tt 



(2) 



WW* -y h- ©ffiB^ftSBo 
[ff*«3] a. $iin#y htf»f3£H£> PHI 
fc £oT!tt©H*S'>4< fcfc 2 0©ffiWWcK#* 

b. MEJItt©fflafclSi;Tg45{g#*ffi7rf5Zk 

ttgtfH-ogtciPgf a fctttc, sag. 29l©-7iK:B 
w» ftfe -b >-»7 MtMAt su m©* yHHTPO 

i:0«J*ffl«*J:tfffl«ftfi0^ft < fc fcl^f ttfrfcfc 20 
»ItajLfc*»«l:tS»Kia#y h-©{ffl$Slgfio 

T, fHSfftft^ Ltt*©»Bl^fc«ffiRM©*£>j6 
SrftfiS ■& fc C fc $1ttt ? *W#B 3 «ie«©gfin 
#«y h©ftl&fc]gBo 

CI*** 5 ] MiE-fe 7 W n # «y h ©&fr#rii 
K¥fTLTE5>J£ft5C fc^StfctSH*«l «*»6 

[M&H6] a. S^IBfcfcttSHaJMftntfyb© 
ftlfc £tmfi<D'>& < fc fclAf n*»*ttfflt*ttffl# 30 
St. 

b. KiE^ai?n/cfiti43<tc;ftSfci®fiifc©<iii 
'>&< fct^-rnA^jEfs^iEm 

«W¥Sfc IT 7 U>f ttfcHW I ,TBB»ftfc»a«© 
attttftb VH-*? ft>fift»). fiBP.a«iP<fryfr©gffi 
©jgBfcjffUgft fr'Mt < fcjj 29\<D*y*)-7W&m 

m?.2mn~-Kiz.wmzAittyitTV'( 40 

a, 

b. iwattfflsnftttifeitfftSkBWffiifcoflBi so 



^^F 3 3 3 0 7 1 0 



4 



a> 

fc£tt3BfiMn*-y KD»J»»Htf*-3T, MIS 
^ffi¥®fc LT 7 U^^tcai^LTiBBy tlfe»»fl© 

©Mi8fcg.9i|gftfc'j>& < fc fc 2 mn^y&TVJ itm 

X§fctt(C, gftgR 2 ?l|©-*tClW*lfe-b >^7 

iBWjrnfe-fey»7U>i'^ai-5W»fl©-fey<HB : F 

©mft«g«©tt»fc*^Tftffl»«ia * -y h ©MB 

fc.ttfft »©**>&< M^yfftfrfr&m-t a e: fc 

[11*5(8] ME£Il2Hfc*ft*Mtt©g**<J>* 
< fc 2 o©ffi®ft?tcE^t *E»¥R*WJ * fcft 

#*aiA-r* fe©T-fes c fc t«w*a 6 
fctt 7 vsm/owssmv # >y h ©»gB 0 

a^tt«t^-©ttfctt^& c fc*ttafc*s«Efti|[ 

6Sfr6 8«©^tlaMcfB«©P3&ibntf-y h-©fM 



[M&H i o ] woa < fc fc 2 jaj©* u-f 

%£xfmisfaitu#t%&mifommyp%. < fc fc 

t >-f ft frfc EH £ ti 5 C fc fclf® fc t SiS*« 6 e> 
9 5©^t" ftfr lcE*©HW»» n # >y b ©tJftiglo 

©^•rn*Hcfet©K)s^»in>i?-y h©0r«igB o 

mm 1 2] WEBPS»»n#y ha«W4a 

MfE^^f^ataaft^t^tiT^acfc 
mm 1 3 ] «a»»n #y h tommies 

a. 6*A«aK*tt*tWBn#y h©tt*©*ffa- 
^KB8t«IM*ftS*fttt«iEt5» 1 ©m 

ftfi*^mta^2©m 

i>©gaw)g«8fcMRWgftfe^a< fc fc 2W©-bv 

■^7U^»<i^afcffiC. MfR2?i|©-/itC§R^|gtlfe 

ibk ffl^tcBWgtift-by»7W»<tBetaMr»ffl 



(3) 



1tffF3 3 3 0 7 1 0 



if 2 ©?a*«ff*© n @B42©fWBB**fc»lELT 
1 4 ] 4>* < t fe MEK#¥8M>ttiSfcfe^ 

i 2a©ffti*»icB«oiK»iio*'y KDSwa 



[ 

[000 1] 
[0 0 0 2] 

mmwm ^$ -regain h t LTtt»ns» 

*n~75!C» PS£2f«4©Jgli©£>©tfiifgStnV 
fitHt VT if©^|pJ%|Rl^TV5©*^EL < SiTf 5 

[o o o 3] Mi gn^tc* 

U\ #PjP85 9-3 200 9^ 13fPB5 9-l 2 1 5 
0 6^ #11635 5-9 7 6 0 9*t&ifT'JfH£fxT^ 

[0 0 0 4] LfrU Ctl5?ffi(C i*fcttt, ftSS 

«£tt. *$m«%©fgMtfWI±T*£&^fctf£ 



[0005] fl5£*tftfc#t sgaotffl • £ft 

©-as**-* > f*»s bximsmzm& lt^s. 

[0006] 

20 [^*<)B^bJ:7fctsiiS] ceamttcowt* 

MfcfcfcTfcSnfcfc©?, ffHSHtt>-f5b>©5yF 

[0 0 0 7] Mt, h©*T% W^»n# 

y h©ttfc*%ffittfgtffcWfcfc©tf, JtHMMfcWfi 

30 H3 3fcSt*tWa»fin#>yhAWa*»5IR 
iltStfiSIP*^LTP«C^©^*Wro c 

[0 0 0 8] %C T, *MtBfiiAfi5fefc#SS¥ 4-24 
1,351 ^tcte^T, KSHAa#v b*i«pgaftif» 

[0 0 0 9] l^oT, C©f8WOg20B«tt> ^©^ 

q & -y h tf^^ftg tc TF L < mW L fe ^ H 2 ^ 
th»tf»ffitt<fe03>t; a -»»ffl^T^lBHIB-p«l»S< 

50 »tt-<-acf:tft*»&^jtfc:. ^»«a-fey»*fflt^T 



7 

B^tt*|ftl±S* a JlfciBfflB^««l**lft±«** 
&5lc LfcM£gftn#y h©«pg@£«$T 5 C fc 

[00 10] 

[|Eg£lS$-fafti6©#g] ±£LfcRB*lBfttS 

ft„ «8t***WOMI*fflEtTWBt*i:, IS* 
9 1 Sfcfcom 8»n#y H, 10 0»lti 

«1t©g&§'>& < t fe 2 o©ffiiBSfcK#'r5E## 

n (n> l) ^© •by-fr&FfrSft'K MfB^fjn*^ 
3 8 2, MjgEi^g (7yP7-ib8 0) 

M B-fey-frTUW 3 8 2 &«»frt3nfl 

K 100 fcMEK^S Fv-* 8 0) tOffl 
[00 1 1] 

[00 12] 

[0 0 13] HlttKW»ilo*y hOo^H*^ 

#BWJ**n*BIW*«ft*-*'eSf ) o l£6fl© 
IS8fiPf4±*>6Wafc, l©P35|elJS!ffl©if|gi5 1 OR, 1 0 
L C&W&R, £«*Lfc*S. ttTHC) > ROVfy 
(xtt£fc»)fclHE) ©Mtfi 1 2 R, 1 2 U R 
n-;V^|p] (yttSfeOfclUK) ©Mffil 4 R, 1 4 
L, «a5On-;l/»|qj<0l»«5 1 6R, 1 6 L. JEfgB© 
t3-/I/£|Si©W@5 1 8 R, 1 8 U l^e>yf-^|pl©MS5 
20R, 20Lk*oTfc0x ^©Tfi&fcttJ&f (JE 
1$) 2 2 R, 2 2 LtfWt*n*k«t» g±ffifc»g 
ft (gflO 2 4tfStf5*U *Ort»fcttlll|a-y b 
2 6A^*nS„ 

[0 0 14] ±Kfc*^TKI»WttH«n OR (L) , 

1 2R (D , 1 4R (D »c>m!t&tu &its.m 

its mm I 8R (L) , 2 OR (L) fr&lJfrSn*. 



(4) ftHF3 3 3 07 10 

8 

Sft> KH0£Mmfc0Hli*B'J >^ 3 2 R, 3 2 
LT% »H»fcJlH*fc<!)BttTBUy*3 4R. 3 4 

LT'»^^na 0 ccx\ wa5y^*2tt£^ojEto 
©6x2 = 1 2<@©wifi om) jfe^n^naiftftst 

$na 0 fttifi^fttiK, ±.mircmmmm-ffr 

1 -3 2 4 2 1 8^ (^¥3- 1 8 4 7 8 2#) ) * 

iftca^nttJ!), ?-niWic©^©sii:ta 

[0 0 15] Hi t^tn*'y h i fcfc^T, JgM&fc 
«l v ft]©6li*-tr>-9-3 6A^tP.tx, JSWfLTP 

#yhfceasn*x. y, zJisiom^fx, f 

y, Fzt^©^|p)tby©t-^>h^Mx, M 

y, uztm^L. &mm<Dm,t%mwn:iJut> 

ZtWjzZZtJjfatZfomZo Sft, JS¥2 2R 

[0016] ?e>(c a#2 4 umfc-tzyv 4 

fc, 0 1 T'titBSta*^ n#y h 1 ©Ig&filfcH: 
30 mn-ty^4 0<Dtiitl^3Et^rc>6<DBM.7,4y^4 
2#Ktt5n«o iltx^©ttJ*(iHufBLftgf*2 4rt© 

W»a^y h2 6fc2l6ft5. 
[0 0 17] 02{i^J»a^y h 2 6©fiMffl£*-f 7n 

§ 0 ^il(Ci3^T«fHr>^4 0*if©ffi*«A/Dt 
gill 5 OTf^/HKcm^tU *OHJ*tt'« 5 2 
*^l/TRAM5 4C2S6n*. Sft#l»t-*tB 
ft LTEH?nax>n-^©tti^tt A ^ y $ 5 6*^ 
LTRAM5 4rt(cA^J?nak«{C> ^X-f>y^% 
40 HOW*(4iBHBBiaB5 8*liTnSllCRAM5 4rt 

K ^2©^»gl6 0, 6 2«nR»6tlT48t), Si 
©iUgSB 6 0 ti^3©5D < R 0 M 6 4 {Ct&SWSftT^ 

R A M 5 4 K3Jfflt §o S ft£f 2 ©SISSB 6 2 tt&E 
©$0<RAM5 4*^^©I®fik«|ffl?nftmflk 
^St^ffiL, #Mli5©S»(c^*»ffi%»tUtTD 

a^flt-^tcHi^tao $fts ROM6 4{C(iftSS 
50 IBUcov^TO«J»«iHflHHtf«««nS. 



(5) 

9 

[0018] cct\ m3ts£vm4Z%MLTmc]i 

%m3 8 2 fc-feytf*#3 8 4 fc^&^figt-StW 
fc< ^(±igP3 8 2 ££¥2 2 R (L) ©KfflJtC^ft^tl 

5®-3oimK7Ujmmmu 

^6nfe*OS«3iai*ttat«o *bT$tiiSI53 8 2 
£ft77-W-7/V3 8 6TNzytf#{*3 8 4 £8$ 

«. *fey*3 8ttfrfi"fflO«WtT^«OT?» 10 

^©^T^/^-^l/^mm^ffl^-^/l^nJft 

^©^>W; 2 £HE& bTStt 2 4 fclRttbfc 
0J03. - >y h 2 6 S TBJW 5 C fc tt, K$!©®!hI btf 

GMKE&ll&JgJnre. 3frtry9-*#3 8 

U i5*f*Wc«iTK , ;>^3 4 R (L) ©rtg&fcg 
*bfc„ 

coo 1 9] jgfc, ££©Tfiyy*3 4 r (D on 
»t » * ft^n, * ;^#s©tt>fifc d / a 3 

9*lfflE«U 1H 0ffl©*>^Hl**5flihJoi 20 
o©7*n?«3fcaailu 3KSy-7;l/7 2*ftbT 

h2 6fl©A/D«§5 0K£tHU *C 

§o £l©858l6 0«v<7s5 2*ftLXk/VW& 

T£¥2 2R (L) ©ftik rttt^ft^ftSfflk ££© 
B»£fr#T£H-2 0 {■©#*>* 3 8 0©tH;ttRa 

[0 0 2 0] CCT\ &9i5{@©*y+M$ttia$3 8 2© 30 
ffflCWi, 5mmt?5 0 JE¥2 2R (L) 
©Utt, 05fc^"rfilt, 2 0 0mmi:tSo frl©5 

^©T% 05fc**$tK, 0iJA(fPig*if©x>y->*^ 

tt*7T**fc*Wn***^fc*, *>©&tfl~4<l 
fcttJ&fSl 5mmOffilfcS5. fttttfEBtfl 5mm 

ftttfttffc&ftlrW ttHMfcLTttlMBBPl 5m 40 

mTtt<Mr t 6 , 5 y Ft-* *¥Jffl bT* 

*8 0©li*-fe>*7W©fii:BlS^H/Hi, IP^ 

ttffi»HIH*ia»©jO< 5mmfcT5fc, *>*7l/-Y 
©S«llgftfC#l2 0mmfc&S©T\ 5ypT-*8 
0©<ife?-*lfc^©2 0mmfctS (BBTJiSB?© 

«i©fe»iwiLT^t) o cnti-aT, 

KttttUtyDttfcilfc ^»J©l-&{c{i±2 0mm 
(4 0mm) i:2fifiU:fcitW«Ck*«-PtSo 
[002 1] c©5VFv-#8 OfCOt/VtltctRfEt 50 



1#rF3 3 30 7 1 0 

10 

7yKT-*8O«07{C^tfi|{C, ftH£|§8 

2 K*v^T^i«wft Giasfia©«^ttBB©77 y y* 

») 8 4 ©SlttrCflcffiOllffiltlfe^-l' V h ts. 

$T'#!$-fi>o C©«fc, 7yKT-*8 0*SWTff 
H£H 8 2 ©^®5:Wfit«V>TJB1t©S*5 2 o©ffi 
SSfcE^-TSo 7VFv-*8 0± 

[0 0 2 2] llT, D*7Htti3 (J3<fctf01) 

t^-rat, si* 2 4 <o±3Kim.^T l 9 0 # s# 

fc@lEiaS:T-77V9 2 *©±ffi;fr&& 
Rt«#^h9 4K±T*|fil (x-zfiD tciHlKSS 
tW»)WJ5nfc*>«7 9 6i:*»5ft5o r-7;V9 2 
t*^7 9 6tfij|^#a fcrtbTBft 
2ft£o BPtu n#y F 1 It, jS«bWW*ifi*T*ff 
U 5«{Cr- 7;l/9 2 t*^7 9 

6fc*»»u H«B«ffla«ai;Ta*©«iR*«B 

ts. ffi> C©f8#DiWttffiB©&&&V''b«:£fr*J 
»fcfe5©T% r- 7;i>a£©flHWJira.fctfii«fta 

lc> *-©UZHM*B8t 5o 
[0 0 2 3] ±K©#ff&Kfc^T, ntf >y F 1 
#18 4fC|t0froT$frU jg¥2 2R (L) tf5>K7 

-*8 0±(cgfiii-r5Ci:T\ c©{fS^rt(c^?> 

ilfctfT'fSo Hfc> ^•fey-9-3 8*%fe©S¥i2.R 
(L) fc-*tfo8tt5ftTIA5tfc**&, Wt^oT 

VS-by^ai^^JtKtSCli:?, 5 ^ FT-* 8 OK 
*f-Ti.£ 5 F2^.R (L) ©Hg> BP^, PS|5 , J>^2© 

6W»ttH1iM!l3«ktf*y5 9 6 «rlCT»e>n«ffij« 

±©* ^ 7 9 6 *BH bTjStttfHI*fT5 C t^T-t 

[ 0 0 2 4 ] C C T% Mli©ffi»ffilf n (fltf) «Jg 
¥2 2R (L) ©ft<8lhrt©J©-ftl©¥i3£-fl>o JE^F 

22R (D ©ftsrna, Bsest*^ £¥©^ 

n©M*S¥©fiT?^CbTjMiES^©Tlftilt5o 
**tWTttfta , f n*ff 5fc©K, -b 2 jajtcG 
■ bfc^ tn*fi¥©WSfceibTWH*pJII6ftH 

< bTftfit*naffl©4WiP«*fii±««fc. 

[0 0 2 5] C©**tfitt±E©lltttlUbft©"P, ft 
aSWK fctt 55> FT-*fc*ft 5 A 



» 
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(6U^;l/©t>©T'j£?)3o 
[0 0 2 6] 09{iCO5IK©^2O^fi60IJ^LT*5 

tK ^yFv-a 8 ofciMWRtf <:© 

8£tt, ttfflLfc7VFv-*8 0©lvfnfrfr5, M 

«t 1 5 C *«T * « • 

[00 2 7] ±fB©H K$2 *St0!l(c£l/-»T, 7> K 
T-*8 0icWt§J£¥2 2R (L) <Dfimt, -150) 

SOttifiTiP&fSttf^ SP^fifxTSHk-rsOT' 

[0 0 2 8] ±E£ 1 , g2$ttMfc43tr*T„ a 
#>y Ftf7> FT-* 8 OttififcHBUfci:** UjLS 
fctt^©lWfCfe^5$*i*^^FT-A 8 0©jtfx£f 

lfcgS©£H«fc2e4^L*ftttT©fii:ftSttfc, 
»MjfrPtSfc©fct^ *©§SJk K&yVT 

[0 0 2 9] ftoT, SKrfr&FW-feyif- ($g/<7;< 
->^OE**Stfrci:J4, *r;i?9 6*£©ftJH! 

[ 0 0 3 0 ] 0 1 0 tt C ©HE©® 3 ©IIM^t 18 

*y F 1 0 0*JBV\ *ft©PWtC*ffi(CjfigLT^ * 
•fe 3 8 ©^ffigl? 3 8 2 £7 b'T WcS« Lfc (01 

fc* S3&8SW©1£, 7yKv-*8 0tt£SttJft8 

4 ©ftBKLhfcffiW 5 jfii C 1 1" 5 PMfr 6 * § 

\c\t3y Ft-* 8 OsWWrefcofcfc*, a*y Ftf 

5 > fv- a 8 o © h c t: ttar s ©jb^a-r s c £ # 

T'f-f, jStHS/^rA©*^5 9 6*SBI±©*5<Ea 

s 3 &»«©«£, 7 > ft-* 8 o # pgr*** 
4Sii©+ja»»6a«iHitftci:-era[©«t»j&c oMi 

[003 1] £i*5£3 nmm<D^?ti<D®$^ & 



(6) fttf33 3 0 7 1 0 

12 

t n $ 7 h ©fflH fc Ib] § t *Kff «WR«t S &B*< 

[0 0 3 2] iSk ^l*^^3H»J{cftt/^T, ntfy 

tf, rvK^3-^©Rg5XTftHLft^S£t>fc 
O#3 0 LfrU *©ttftfr-*tt*-C*!>, 7J-£C 
fc5> *^79 6*ffiffll/TiB©tttfc7yFT-* 

[0 0 3 3] 01 2ttc©BW©£4llfi60iJ£;St7n 
— • FT*&D> £©£HlCffi3gWttl*&ll©fl 

*?fMWcH*3. Hi 3 P§S©#W43J; 
tf&gfcti^y Fv-A 8 0 WRRSti*. 
[0 0 3 4] ft, jg4£ftffll& #ffl$tAtfftfc»fgL 
20 fcfflS CBM¥ 4-2 4 1, 3 5 1 ©KaTSSo 

aas© i ottttHttiH^a-p, *fcfflv^aa»s©» 

yt-by?3 8*mLrcCtlc&5o tftfco^ 

m ifefca^fc. ijfijSi©2oa:, pgg#w©ffitt 

[0 0 3 5] (!©0JfflttBujitLT, o^yhfcPBS© 

30 ffl«ffli©*mi*t%<T%ais©#K* < Rrtifti^, 
mmrnu 1 a©^B-e584t4«»ffi»f 

A6ti*©-e, C©^Ii)T'{iJSP^gfflffi«tcES|{ct 
«*€Sftl&©*J»ttfT*>'f , ttS© 1 ST'ffi^&Hf 

n*^4t5 c t iimtzt>\ c ©fflWffin-f n«« 

fcaBitf 4*»P*fT4V\ F tpgg© 

40 [0 0 3 6] 0 1 4 tt, COMWOfHK^tMIP^D 
>y*0T'£5. 0T\ S (z) ttiSS^ffifi (gft 

m » u (z) tt$wi^fl atfiFi) > y (z) an 

S«!fiB (^Jfflil) » E (z) liffi»ffi»rn (MM 

M) . a (z) am. i (z) ttn^sR, (i/ 
z) ttitfy^yvTatiR*, k (z) 

G (z) tto^yF ($JWM) ©*«ffi^ftfr&** 

fi*-e©/wxfian»*ai/T^*. c:n5>©i8^ 

tt, ftl, ^2{C^t«lC^:§ 0 
[00 3 7] 
50 [» 1 ] 
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Y (z) = 



(7) 

G (z) {1 +z- ] I (z) K (z) ) 
1-f z-M (z) K (z) G (z) 



1#fF3 3 3 0 7 1 0 
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S (z) 



1 



1 +Z- 1 I (z) K (z) G (z) 



A (z) 



G (z) (z- 1 +K (z) ) 
z-l+K (z) G (z) 



S (z) 



z- 1 



z-l+K (z) G (z) 



A (z) 



[00 3 8] 



B (z) 



z { 1 ~G (z) } 
z- 1 +K (z) G (z> 



S (z) 



z - 1 +K Cz) G (z) 



[0 0 3 9] fit, IBKMhOfcftt, G (z)W> K [0 0 4 0] 
g, frfflSHK (z) *y-Y>kktntf, ££*fttt [S3] 

I z I < 1 



A (z) 



l-kg<l -* -kg<0 -> kg>0 
- 1 < 1 - k g -* -2<-kg -* k g < 2 



0 < kg < 2 



[0 0 4 1] Sfc, PBfSOfiS^L (HI Sfc^T) T* 30* L fcJSCT-^fifcJR^tS, 

-sftetf, aafflittxr^ ^Rtaft-rsoT?, c [0042] 
tucmzfemmt, »4t*t«i«:a9, k, g , ★ bro 

z 

• L • 



e°° = 1 im (1-z" 1 ) 
z^l 



z- 1 



z (1-g) 



z- 1 + kg 



z (1-g) 

= 1 i m L 

z-* 1 z - 1 + k g 



1 -g 
kg 



[0043] mmtc, *t£D®-f y/W/*tt0tta}3 at-So 

<ktfXry^KO^afc»tSSttfflMtt»5, R6fc [0 0 4 4] 
^ttttftO, OSfcttk, g, DfcjSUT-SfifciR [»5] 
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e oo = 



(8) 



#ffF3 3 3 0 7 1 0 
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1 im (1 
z—1 



-z-') 



-e 



D 



z - 1 +k g 



(z- 1) ■ z" e 

= 1 im D 

z-»l z - 1 + kg 



kg 



[0 0 4 5] 



= 0 



e oo = 



I i ra ( 1 
z-l 



-z-) 



* * [gt6] 
Dz 



z-l 



z - 1+kg 



= 1 im D 

z-»l z - 1 +k g 



kg 



D 



[0 0 4 6] f-fykiM&KZfc&^TftiLrcm 

[0 0 4 7] CCT% ffG (z) ^WgfcLTlHl 
5£Lfc 0 01 6SJx (n) /u (n) 
gLfc&©T*&5 0 M,©^*#t: fcfG 

(z) , mt>, g%n%Lrc^tC5T'$>&t>\ w 30 

(n) mmmmx-h^robic, x u) /u (n) 
t*5t©«yctv>i:it£sn5©^ g (z) %yw 

0 2T'&?>©T\ g=l. 0 2tLX$>&^£g,t)tlZ> 
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